#include "limit_switch.h"

ISR(PCINT0_vect) {

	changeStatus(STATUS_WARN);
	USART_Send_String("ERROR\n");
	while(1) {
		;
	}
}

void initLimits() {

	// External interrupts
	PCMSK0 |= _BV(PCINT0);  //Enable PCINT 28
	PCMSK0 |= _BV(PCINT1);  // Enable PCINT 29

	// Enables de interrupts
	enableLimits();
}

void enableLimits() {

	PCIFR |= _BV(PCIF0);
	PCICR |= _BV(PCIE0);
}

void disableLimits() {

	PCICR &= ~(_BV(PCIE0));
}
